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ABSTRACT 


The problem of designing a robust decentralized 
linear quadratic controller of a robot arm manipulator 
has been tackled in this thesis. Recursive Lagrange- 
Euler equation of robot arm motion has been linearized 
around a trajectory and linear error models have been 
obtained, A decentralized controller has been designed 
for a PUMA-560 robot and its performance has been 
evaluated for various load conditions. Tracking of 
the trajectory has been found satisfactory under these 
load conditions. The important conclusion of the 
thesis is that only one controller is used for the 
whole trajectory and there is no need to calculate 
the controllers on line. 


CHAPTER 1 


INTRODUCTION 


1 . 1 ROBOT MANIPULATOR 


An industrial robot is a general purpose, computer 
controlled manipulator consisting of several rigid links 
connected in series by revolute or prismatic joints. One 
end of this chain is attached to a supporting base, while 
the other end is free and equipped with a tool to 
manipulate objects or perform assembly task. 

A robot manipulator consists of an arm sub-assembly 
and a wrist sub— assembly plus a tool. The arm sub— assembly 
generally can move with three degrees of freedom. The 
combination of the movements of arm sub-assembly positions 
the wrist unit at the desired location. The wrist sub- 
assembly unit usually consists of three rotary motions 
and orients the tool according to the configuration of the 
work piece. 


1.1.2 Robot Control Problem 



The control problem of a robot manipulator can be 
conveniently divided into two coherent sub-problems [lO] 

1) Motion (or trajectory)planning sub-problem, and 

2) Motion control sub-prpbl^, ^ 


^he,r5 l^i^^pb'iates and/or approximates 

functions and 
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generates a sequence of time based control set points for 
the control of manipulator from the initial location to 
the destination location. The trajectory planning can 
be done either in joint variable space or in the cartesian 
space. (For a robot with revolute joints, the joint 
variables are the anglesbetween the links and for a 
robot with prismatic joints, the joint variables are the 
distances between the joints). For joint variable space 
planning, the time history of all joint variables and 
their first two time derivatives are planned to describe 
the desired motion of the manipulator. For cartesian , 
space planning, the time history of manipulator hand’s 
position, velocity and acceleration are planned. 

The motion control problem consists of two parts i 

1) Obtaining dynamic models of the manipulator, and 

2) , Using these models to determine control laws or 

strategies to achieve the desired system response 

and performance. 


Robot arm dynamics deals with the mathematical 


formulations of the equation of motion of the robot arm. 
The mathematical formulation of robot arm motion is 
necessary for computer simulation of the robot arm, 
design of suitable control equation, and evaluation of 
the kinematic design and st^dt lira , of the robot arm. 

The last use of dyndaip equai.i©n robot motion is not 
inclpdad in present present work, the 




dynamic equation has been evaluated for obtaining a 
nominal control for the robot joints and for a computer 
simulation of the arm. 

As it turns out, the equations of robot arm 
motion are highly nonlinear and the established design 
methods for linear systems cannot be applied directly. 

Several authors have tried to design the 
controller for the robot manipulator based on various 
techniques. A great majority of them have developed 
the controller in joint-variable space by nonlinear 
compensation of the coupling forces among the various 
joints [lO]. But this method of designing the controller 
has a serious draw back in the sense that the non- 
linearities may not be exactly cancelled by the non- 
linear compensators which may result in poor closed 
loop stability and performance [3]. Hence, as far as 
possible, the nonlinear compensation should be avoided. 

An alternative strategy to design a controller 
could be by linearizing the dynamic equation of motion 
around the nominal trajectory and then designing a 
robust controller for this linearized dynamic equation. 
The controller design consists of two steps, 

1) Nominal control design, and 

2) Feedback control design* 



1.2 CONTROL STRATEGY 


In the present work, the following control 
strategy has been formulated. A nominal control is 
designed that propels the robot arm to the vicinity of 
the desired trajectory point. Near the trajectory 
points, the nonlinear equation of motion is linearized 
for the error in joint variables and linearized models 
obtained. An LQ regulator is designed for these error 
models that retains the optimality of the closed- 
loop system for all the points on the trajectory. 

This controller has been implemented and performance 
of a PUMA— 560 robot has been evaluated. The trajectory 
tracking has been found satisfactory. 

1.3 BREAK-DOWN OF CHAPTERS 

In Chapter 2, various methods of evaluation of 
robot arm dynamics have been discussed briefly with their 
rela^itive merits and demerits. A special mention of 
recursive Lagrange-Euler technique has been made. A 
method is given, in this chapter, to obtain the nominal 
torque for a given trajectory point in joint variables. 

A linear error model of the robot has been obtained using 
recursive Lagrange-Euler equation and algorithm to obtain 
the nominal torque and linear podel is given. 


Chapter 3 discusses the methods of robot control. 
In the present work an attempt was made to design a 
decentralized controller consisting of a nominal control 
and a feedback control to bring the tracking error as 
close to zero as possible. The decentralized controller 
was designed based on a technique developed in [13]. 

This chapter briefly reviews this technique. 

The decentralized controller designed in [13] 
guarantees the robustness of the plant against the 
variations in plant parameters. 

The decentralized feedback controller for the 
robot has been designed based on this technique for a 
PUMA-560 robot and implemented. This chapter presents 
the evaluation results of the controller for various 
load conditions. 

Chapter 4 concludes the thesis. In this chapter, 
the observations have been made regarding the controller 
and its performance. 


CHAPTER 2 


EVALUATION OF ROBOT ARM DYNAMICS 
2ol INTRODUCTION 


Robot arm dynamics deals with the mathematical 
formulation of the equation of motion of the robot arm* 

The dynamic equations of motion are a set of mathematical 
equations describing the dynamical behaviour of the 
manipulator. Such equations of motion are useful for 
computer simulation of robot arm motion and design of 
a suitable controller for the robot arm. Actual dynamic 
model of a robot arm can be obtained from physical laws 
such as the laws of Newtonian and Lagrangian mechanics. 
This leads to the development of dynamic equation of 
motion for various articulated joints of the manipulator 
in terms of specified geometric and inertial parameters 
of the links. Conventional approaches like Lagrange-Euler 
(LE) and the Newton-Euler (NE) formulations are then 
applied to systematically develop the actual robot arm 
motion equations. 

As it turns out, these equations of motion are 
highly coupled and nonlinear. Therefore, the state 
equations derived from these highly nonlinear coupled 


dynamic equations are also nonlinear* A convenient way of 
representing the dynamic equation of motion of robot arm 
could ;be/'’-''tf^tfA.;i, ^ 
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i = £ U» £,xo» lo^ 


where 

X 

f 

X 

__o 

f 

_o 


state vector 

Vector of applied forces/torques 

Initial value of state vector 

Initial value of applied force/torque vector. 


Although a fairly large amount of research has been 
devoted to the design of controllers for nonlinear systems, 
the design procedures are not yet as standard as those 
for linear systems. Therefore, the emphasis is either on 
global linearization of the original nonlinear system or 
linearizing it in the operating region via a suitable 
transformation. In the present work, the nominal torque/ 
force, the torque/force that propels the joints to the 
sufficiently close neighbourhood of the desired trajectory, 
is calculated on the basis of the nonlinear dynamic 
equations and the feedback torque to reduce the tracking 
error is calculated on the basis of a linearized model 
(dynamic equation linearized around a trajectory). 

The chapter has been organized as follows. Section 
2.2 deals with various methods of calculating nominal 
torque alongwith their merits and demerits from the point 


of views of number of operations required to be performed 
and design of a controller. Sedtiqa 2.3 gives current 
approaches in linearizatl®^ <>f nonlinear dynamic equation 
of robot ai® mot|^. Section 2.4 an algorithm 
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for calculating the nominal torque and linearized model 
about a trajectory. This algorithm has been applied to 
a practical example of a PUMA-560 robot and nominal 
torque and linearized models are obtained. It may be 
noted that the values of nominal torques obtained for 
the joint angles, velocities and acceleration as obtained 
here are the same as those reported in [2]. 

2.2 NOMINAL CONTROL 


In order to move the end effector of a robot 
manipulator from an initial posit ion/orientation to a 
final position/orientation along a specified trajectory, 
the controller is required to produce a nominal control 
torque/force which will move the end effector along a 
given trajectory. For this purpose as also for designing 
a control system to achieve satisfactory tracking, it is 
necessary to derive the dynamic equation of motion 
describing the dynamic behayiour of robotic manipulator. 
Several methods of deriving the dynamic equation of a 


robot manipulftor such as Lagrange— Euler (LE) method, 
Newton-Euler (NE) method generalized D'Alembert (GD) 
equation etc, have been discussed in the literature. 

All these methods, except Newton-Euler method, 
need very large amount of time for computer evaluation 
of dynamic equation. JA comj^rision of the time required 
by various method^ has giv^ in C^], [lO], from which 
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it appears that the Newton-Euler method is best suited 
for computation of nominal torque as the number of multi- 
plications and additions is proportional to the degree of 

freedom (n) of the robotic manipulator as opposed to 
4 3 

n and n in Lagrange-Euler and generalized D’Alembert 
methods [lO] respectively. 

From the point of view of only calculating the 
nominal torque, one is normally governed by the following 
considerations while selecting a method of computation of 
nominal torque. These are : 

1) Method should be easy to formulate. 

2) Method should be easily converted to computer 
algorithm, and 

3) It should lead to efficient numerical evaluation. 


This might prompt one to use the NE method. 
However it is difficult for it to be applied to the 
design of control system as this method does not lead 
to a set of closed and explicit form differential or 
state equations required for designing an appropriate 
controller [5]. From this point of view, the Lagrange- 
Euler equations of motion are in the most perfect form 
for the design of control systems [5]. 


Several efficient algorithms have been proposed 


e.g. [5]f [9], for evaluating the dynamic equations which 
reduce the number of computations required in LE method 
and thus bring^^ rthis methqd at par with the NE 


equation from the point of view of number of multiplica- 
tions and additions required to calculate the nominal 
forces/torques. 

The Lagrange-Euler equation of motion of robot 
manipulator can be written as 


where, 

q :An nxl joint variable vector = [q^* 
g I An nxl joint velocity vector = [q^^. 


( 2 . 2 . 1 ) 

• • iT 

^2 > • • • 


q 

D 

h 

c 

f 


: An nxl joint acceleration vector = • • • »% ]^ 

I nxn symmetric positive definite inertia matrix, 

; An nxl Coriolis , centrifugal and gyroscopic force/torque. 

T 

vector = [h;^, h 2 , ,h^] j 

: An nxl Gravity loading force/torque vector [<^i»^2» • • -CijJ 
: An nxl Input force/torque vector = [fj^t ^2»*'**^n^^ 


Equation (2.2,1) can also be written as (see 
Appendix A) 

n j dW. dwT 

f^ = ELI (Tr(^ J. ^)) q'j^ + 

^ j=i k=l J K 

j j ^ dW. d^wT . T 


where 




;Pseud|>f inertia 


i = 1,,.. ,n 


;tensor of link j 


( 2 . 2 . 2 ) 


Wj = homogeneous (4x4) co-ordinate transformation 

t h 

matrix from j co-ordinate frame to the base 

co-ordinate frame. 

„ = as defined earlier 

qj = as defined earlier 

d. = as defined earlier. 

-J 

Equation (2.2,2) can be written more compactly 

as [3], [9] 

n dw.s -T* dW-? 


jj^ — - X|***«|n 


(2.2.3) 


where 


“j 


n dWj 


j 

2 


d^W 


i 




\ % 


(2.2.4) 


This formulation, greatly reduces the time 
required for computation. For this formulation several 
backward and forward recursive relations have been derived 
in [9], It has also been shown in [9] that if we use 
3x3 rotation matrices, instead of 4x4 rotation translation 
matrices, a further saving (of the order of 50?C), on the 
operations required to be performed can be achieved. 

The discrete dynamic models can also be obtained 
directly if it is required [7]. 
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Forces/Torques obtained from (2.2,3) are then 
applied to the manipulator joints to move the end 
effector from initial position/orientation to the final 
position/orientation* However, if these are the only 
forces/torques acting on the links, it becomes the 
open loop control and it can not be predicted as to 
how closely the joints follow the desired trajectory. 
This is specially so if the joint parameters are not 
accurately known or if the load variation is there. Then 
the desired trajectory may not be followed at all. Hence 
there is a need to design a controller which will make 
the joints and, therefore, the end effector track the 
desired trajectory in the presence of uncertainties 
like load, variation in link parameters, inaccuracies 
because of finite computer precision, mechanical effects 
such as friction, vibrations etc. This controller (to 

i 

be discussed in Chapter 3) has been designed on the 
basis of a linearized dynamic robot model and implemented 
as feedback. This essentially generates corrective 
forces/torques to those produced by the open loop control 
discussed before. 

2.3 LINEARIZATION OF DYNAMIC EQUATION OF ROBOT 

The most common technique of linearization of a 
nonlinear equation is using a transformation or a non- 
linear feedback. 'Sevetal a^iibrs have reported methods 
of linearization of nonlinear dynamics about a point or 
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a set of points e.g, [8], [12], But these techniques 
suffer from the drawback of inexact cancellation of non- 
linearity by transformation or feedback which may 
result in poor closed loop stability and performance. 

Neuman and Murray [6] have proposed a method to 
linearize symbolically the Lagrangian dynamic robot 
model about a nominal trajectory. However the 
algorithms based on it cannot be run on computers (such 
as DEC-10) which do not have the capability of symbolic 
manipulation. 

Balafoutis et al. [3] have presented a technique 
for recursive evaluation of linearized dynamic model 
about a nominal trajectory using sensitivity matrices. 

A sensitivity matrix contains sensitivity functions 
which, physically, characterize the perturbations of 
the joint co-ordinates and velocities from their 
nominal values in response to variations in kinematic 
and dynamic parameters of the links [6]. (Kinematic 
parameters of a link i with prismatic joint are angle 
between links i-l and i, the twist angle of link i; 
for a revolute i^^ joint these parameters are distance 
between links i-l and i, length of link i and twist angle 


of link i. Dynamic link parameters appear in the pseudo- 
inertial matrices). 

Lagrange-Euler ^uatipn of motion of a robot is 
given as (2*2,1) and lias y^rltten as equation 
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Let us now define 


T 

R. = J.W. + A. , R. , 
1 11 1+1 1+1 


and 

Then equation (2.2.3) can be written as 

dW. T dW. 

h = ’'r(^R^)-g 


(2.3.1) 

( 2 . 3 . 2 ) 


(2.3.3) 


= l-(q, q, q) +‘T»:(q) (2.3.4) 

where 

dW. 

“SuCq, q, q) = Tr{-§^ r^) ( 2 . 3 . 5 ) 

T dW. 

and “S' (q) = -9^ 5 — (2,3.6) 

Equation (2.3.4) can be expanded about a nominal 
trajectory (q°, q®, q®) (q°, q®, *q® denote the nominal 
solution of equation(2.2,l) with nominal input force/ 
torque £q)« 

The first order approximation of equation (2.3.4) 
around the nominal trajectory can be written as [3] 

if = V® fq + P® A (2.3.7) 

where tTf, <$q» f4 and ^^R*^ are sufficiently small 
deviations from the nominal values f°, q®, q® and q®eR’^, 
D® is the inertia force-acceleration sensitivity matrix 
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and Coriolis force velocity sensitivity matrix 
evaluated about the nominal trajectory and P° is the 
force-position sensitivity matrix also evaluated about 
the nominal trajectory. 

Let us now define the state vectors 


Then 


-1 


^2 


ia = [ 

A = = [<&!» * 


and 


or 


il 


^2 




-1 


= D° [ if - V® A - P® iq] 


.-1 


D° [ {f - V°X2 T P°Xj^] 


-1 


-1 


-1 


= -D" 


V°X2 + D® ij 


1 


V 

L 



-D° ^P°l -D° 


1^1 


0 

-1 


D' 


ff (2.3.8) 


or 


X = Ax + Bu 


(2.3.9) 


Comparison of (2.3.8) and (2.3.9) yields 
x ’' = [x J j J(|f = 


= [fqjLf ..f cTq^f fqj^,...., i'qj^] 



♦ I = (nxn) Identity matrix 


A is, therefore, 2nx2n state matrix and B is 2nxn input 


matrix. 

Clearly equation (2,3.8) describes a time- 
invariant linear model of robot about the nominal trajec- 
tory. Matrices A and B always exist because D° is an 
(nxn) symmetric positive definite matrix [6], Elements 
of matrices D°, P° and V° can be obtained by the following 
equation [3] 
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and and have been defined in equations (2,3.1) and 

( 2 . 3 . 2 ). 

Efficient algorithm for computing various matrices 
has , been given in [3]. An advantage of using this 
algorithm is that the nominal torque (inverse dynamics) 
can also be calculated simultaneously. 

2.4 ALGCBITHM 

An algorithm is given below for calculating nominal 
torque/force and a linearized model. 

1) Read kinematic and dynamic parameters of all the links 
and the trajectory points for which nominal toirque and 
linearized models should be calculated. 

2) Calculate matrices relating different co-ordinate 
frames and their derivatives wrt time and joint 
variables. (An efficient algorithm for this is given in 
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3) Calculate nominal torque for the first trajectory 
point. 

4) Calculate a linearized model of robot manipulator 
(A and B matrices) at first trajectory point. 


5) If their are any more trajectory points, repeat Step 2 
through 4, otherwise exit. 

EXAMPLE 


For the purpose of designing a controller, matrices 
A and B have been calculated for first three joints of 
PUMA-560 robot. As can be expected these matrices are 
dependent on load. Also a nominal torque has been calcu- 
lated for a set of values of joint angles, angular 
velocities and accelerations. Matrices A and B for two 
different sets of joint angles, angular velocities and 
angular accelerations are presented in the Appendix C. 


2,5 CONCLUSION 


Problems of calculating inverse dynamics and lineari- 
zation of the nonlinear dynamic equation of a robot 
manipulator have been considered in this chapter. It has 
been observed that an algorithm that does not require the 
cancellation of nonlinearity by a nonlinear transfonaation 
is preferable. If possible, an algorithm that produces the 


nominal torque alpn^ith the linearized model should be used to 
reduce cc^^pta^ilonsi An algorithm has been presented and 







applied for first three joints of PUMA-560 robot for 
obtaining the nominal torque and linearized model. It 
has been observed during execution of computer program 
that computation of linearized model and nominal control 
requires less than 0,5 sec for one trajectory point. 


CHAPTER 3 


ROBUST LQ DECENTRALIZED REGULATOR DESIGN 
3.1 INTRODUCTION 


The control problem of a robot arm manipulator can 
broadly be devided in two steps. 

1) Obtaining the dynamic model of the manipulator, and 

2) designing a controller. 


Dynamic model of the robot has been obtained in Chapter 2, 
Current industrial approaches to robot arm control 


system design treat each joint of the robot arm as a 
simple joint servomechanism [lO]. This method of 
controlling the joints results in reduced response speed 
and damping and limited precision. The arm also moves 
with unnecessary vibrations. This is because the arm 
dynamics is not modelled adequately. 

Various techniques have been reported e.g. [4], 
[lO], [ll], [14]-[16], for obtaining the improved speed 
of response and accuracy of tracking. Some of these 
techniques deal with resolved motion control [4], [lO] 
and nonlinear feedback [lO]. Schemes have also been 
presented for task oriented control of manipulators [14]. 


Controllers have also been designed using L 2 and L^ 



stability approaches 




21 


The present work reports a robust LQ decentralized 
controller design for the control of robot arm joints. 

The performance of the controller is almost insensitive 
to the changes in the load on the end effector. The 
controller is easy to implement because each of the 
joints can be considered to be a single sub-system 
which is independent of other sub-systems (joints ) for the 
purpose of implementing the controller. 

The chapter has been organized in the following 
manner. Section 3,2 presents the methodology and the 
implementation details of the controller. The controller 
as designed in this section was used to evaluate the 
response of a PUMA-560 robot. The results of this 
evaluation are presented in Sections, 3, Section 3,4 
concludes the chapter with some important observations. 

3.2 CONTROLLER DESIGN 


The controller design consists of two parts : 

1) Designing a nominal control, and 

2) Designing a feedback law. 

Nominal control torque can be calculated for a 


particular trajectory point using equation (2.3.3). 

Use of this equation needs the evaluation of R^ matrices 
and vectors. R^ matrices can be obtained using 
equation (2,3,l)?i®i 31^ ye'ptpxs can be obtained using 


equation 


•*. ' 






are evaluated 




in backward recursion, i.e. we start from i = n (number 
of joints) and proceed towards i = 1. The important 
observation here is that we should assign a null 

matrix in equations (2.3*1) and (2,3.2), Then and 
can be calculated forivarying from n to 1. Other 
matrices required for calculating the nominal torque 
are also required for obtaining a linear error equation 
of robot manipulator around that point. Hence it is 
advantageous to calculate nominal torque while obtaining 
linear error model. 

The nominal torque propels the joints to the 
neighbourhood of the desired trajectory points. A 
decentralized feedback control law is designed for 



the whole trajectory such that it retains the optimality 
and robustness for all the trajectory points under 
various conditions of loading and thereby ensures 
excellent tracking accuracies. The control system is 
then implemented as a MIMO syst«n with decentralized feedback 
The decentralized feedback control law has been designed 
using the method developed in [13], A brief review of 
this method is given below : 

Let the equation of the robot arm motion be given as 


u is an m-input vector 


where x is an h 


jB; is an nxm input matrix 


Ap and B are both constant matrices 


This system can be decomposed as below treating 
each joint as a sub-system : 

Sip : (3.2.2) 

where i = 1,2,..,,,., r (No. of joints) 

= n^j^-state vector 
u. = m. input vector 
Aii = n^^xn^^ state matrix 
®i ” n^xm^ input matrix 
Aij = Hji^xnj interconnection matrix, 
n 

The term Z A..x. represents the coupling of 
i=l ^ 

j?^i 

other joints with i^^ joint. Neglecting this term. 


X. = A..X. + B,u. 

-i ii-*i 


(3.2.3) 


Writing a compact equation for the complete system 
neglecting interconnections; 


and 


- ApX + BpU 


" T T T Ti T 

whe re x = f x^^ , 


' ff4 ' 






f r 




’4 4 -.*“ 


Ajj and are block diagonal matrices defined as 


Aq — diag (Aj^, • * • • »A^) 
Bjj = diag • • » • 

where. 


A, = 


Let a matrix Aq contain all the interconnection 
terms. Then assuming that the pair [Aq,Bj^] is completely 
controllable and the pair [A^, D] is completely obser- 
vable, the control law obtained in [13] is 

* 

u = -L„x 
where is given by 

t-a = (3.2.4) 

P is the nxn real unique p.d. symmetric matrix and is 
cc 

the solution of the algebric Riccati equation (ARE) 


A^l A^2» 


, A 


in. 


"il 


A_ y 
ni2 


.A, 


hini 


J 


B. = 


Bil 


.. B 


im^ 


B. 

in. 


,B. 


n .m- 
11 
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This control law minimizes the quadratic cost 
function 


= / e^“^(x^Qx + u^Zu) dt 


(3.2.7) 


where 


Q 

Z 


,Qr) 




z, = 


diaq (Qj^t ..... 

diag »2j.) 

r^n^^p.s.d. state weighing matrix 
n^m^p.d. input weighing matrix 


and a in (3.2,6) is so chosen that the matrix is 


atleast n.s.d, where 

F = A^P + P_A - Q - 2aP 
c a oC^c ^ a 


(3.2.8) 


The scalar a is defined as the degree of stability 
[1] which physically means that the closed loop poles 
of the system are placed to the left of S = —a in the 
S-plane, 

The initial gauss of a can be obtained from the 
following equation 


«■ > H nax P;^] 


-1 

o 


(3.2.9) 


where 


X [•] is maximum eigen-value of matrix [•], and 
max'* 



Q = A^P-: + :P is the solution of 

E ( 3,2^51 in: ■ 
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The value of a which makes in (3.2,8) atleast 
n.s.d, when used in in (3.2.7) results in a feedback 
gain matrix which when used in full model with inter- 
connections guarantees optimality of the resulting 
closed-loop system [13]. The optimality in turn 
guarantees excellent robustness properties for the 
closed-loop system. 

A program has been written using this method. 

The program needs the maximum load expected and the 
trajectory points around which the controller should be 
obtained. It calculates the controller for different 
load conditions (e.g. no load condition, maximum load 
condition and half load condition) at various trajectory 
points and evaluates which controller retains the 
robustness and outputs that controller. An algorithm 
for obtaining the controller is given below : 

1) Obtain the linearized models around the desired 
trajectory for no load. 

2) Obtain matrices A^, A^ and 

3) Choose a = 0 and obtain as a solution of ARE 

^ o 

(equation 3.2.5). 


4) Obtain a conservative estimate of a using (3.2,9). 

5) Substitute a in (3,2,6) and obtain as a solution 


of (3.2.5). 

6) For this a and P_, Chefbk if ( equation 3,2,8) is 


7) If is n.d., decrease the value of a and repeat 
steps (5) and (6). If is p.d., increase the 
value of a and repeat steps (5) and (6)* 

8) Repeat step (7) till a minimum value of a is obtained 

such that F is n.s.d. 
a 

9) Repeat steps (1) to (8) for different load conditions. 

10) For each controller obtained above, check which 
controller retains optimality for all loads and for 
all trajectory points. (This can be done by 
checking whether F^ in equation 3.2.8 remains n.s.d. 
or not). 

11) Output the controller that retains optimality for 
all loads and for all trajectory points, 

3,3 EXAMPLE 

A nominal control and a feedback control gain matrix 
were designed for a PUMA-560 robot for the evaluation of 
control strategy followed in the present work. The evaluation 
has been carried out for first three joints only. 

Figs. (3,3.1a) to (3,3.1c) present nominal trajectories 
for the robot arm joints which they are required to follow. 

A nominal control was designed for no load condition of robot 
arm for these trajectories. If unloaded arm is driven by 
this nominal control, the tracking performance will obviously 
be satisfactory. To find the degradation in the performance 
with changes in load, pe^or^ncd'^s observed by driving 
the ! aim; ncxainai loaded with a cubic 
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load of 6 weight and 0,1 m dimension. 

The performance of the robot was observed for two 
seconds in the open loop. As seen from the Fig, (3.3.2), 
the arm moves with large vibrations and does not settle to a 
final position even after two seconds. Also the maximum 
error in tracking for the joints is as high as 0.48 rad, 

0,41 rad and 1.00 rad for first, second and third joints 
respectively. 

Feedback torque is now applied to the joints and 
the performance of the controller observed for three 
different loads. Fig, (3,3.3) presents the perfoirmance 
of the controller under no load condition. It is observed 
that the maximum error in tracking for the first joint 
is around 0.022 rad and the joint finally settles to the 
final value 0,0043 rad in 0,93 sec. Similarly maximum 
error for joint two is of the order of 0.021 rad and it 
settles to 0,0062 rad in 0,93 sec. Joint 3, however, has 
larger error which is of the order of 0.04 rad and it 
settles to 0,0059 rad in 0,93 sec. 


The arm was now loaded with a cubic load of 3 Kg weight 
and dimension 0,1 m. Errors in trajectory tracking have 
been plotted in Fig, (3.3,4) as a function of time. Avery 
marginal degradation in performance is observed with maximum 
tracking errors of 0.026 rad, 0,025 rad and 0,065 rad for 
joints one, two*' aftd^ three respectively. But the steady 
state '"errot" hk'l|''COB^Irged-^V't1|e'*satee values in the same 


\ k." ' 









case (Fig, 3.3,3), 




iiliilll 
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The load was then changed to cubic load of 6 Kg weight 
and 0.1 m dimension. Fig, (3,3,5) presents the error in 
tracking as a function of time in this load condition. 

Again a marginal degradation of performance is observed in 
the sense of maximum error in tracking (0.031 rad, 0,033 rad, 
and 0,13 rad respectively for joints one, two and three). 

But the steady state errors converges to the same value as 
obtained in no load case in the same duration of time, 

3c 4 DISCUSSION AND CONCLUSION 

It was observed in Section 3,2 that the controller 
designed as described there retains optimality property 
under various load conditions. The optimality property in 
turn guarantees excellent robustness properties like infinite 
gain margin and 60® phase margin for the closed-loop systo’^ 
Figs, (3.3,3) - (3,3.5) clearly show that controller re jis 
the satisfactory performance when the load is changed from 
no load to 6 Kg load of 0,1 m dimension including all inter- 
mediate load conditions. Only a marginal degradation in the 


maximum tracking errors is observed. 

Section 3,2 also indicates the importance of parameter 
a. It was observed during the design of the controller that 
the value of a required to make F^ matrix (equation 3,2,8) 
n.s.d. is largest for no load condition at that point on the 


trajectory where 


J 1 


.t" 





velocities and accelerations are 


; ^piht repre^^ents the worst case condition, 

fpr such a condition will 
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preserve optimality property for various load conditions. 

It may be worth comparing the tracking accuracies 
obtained using this controller with some other methods of 


controlling the manipulators. Slotine [17] has reported a 
comparision of tracking errors of proportional derivative 
(p*d. ), computed torque and adaptive controllers. Comparision 
of the maximum tracking errors under no load condition suggests 
that the performance of adaptive controller, computed torque 


controller and the one designed in this thesis are comparable 
whereas p.d, controllers definitely seems to be inferior with 



larger tracking errors. When the arm in [17] is loaded, 
tracking errors increase. This increase in errors is much 


higher than that experienced in the case of LQ controller 
designed here. Steady state errors also increase significantly 
in [17] whereas no appreciable increase in steady state errors 
has been observed in the present case. So in this respect the 
performance of the robust decentralized LQ controller designed 
in this thesis seems to be superior. Added to this superiority 
of performance is the ease in implementing this controller. 
Whereas adaptive controllers are very difficult to implement, 
the decentralized, constant LQ controller is very easy to 
implement. Since there is only one controller for the whole 


trajectory, there is no need to calculate the controller on line 
Once the trajectory planning has been done, controller can be 


designed off-line and implementi^d' 
in the case of adaptive controllers 


very cost-effectively unlike 


trajectory of joint 








trajectory of joint 2 
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time(sec) 





trajectory of joint 3 
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time (sec) 
Fig, 3,3,1c 


tracking err. of jt.l in open loop 



Fig. 3.3.2a 
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Fig, 3.3.5b 






CHAPTER 4 


CONCLUSION 

Main results of the thesis have been summarized in 
this chapter* 

In Chapter two, the problem of the evaluation of robot 
arm dynamics was considered. Linearized error models about a 
trajectory have also been obtained. Finally an algorithm 
has been given for finding the linearized models around 
the trajectory. It was also pointed out that the nominal 
control can also be obtained while evaluating the linearized 
models. 

In Chapter three, the problem of designing a robust 
controller was considered, A method to design the decentra- 
lized LQ regulator was presented and a controller for 
PUMA— 560 robot was designed. The performance of the 
controller was evaluated for various load conditions. It 
was observed that a controller designed for no load and 
for a trajectory point where highest velocities and 
accelerations are encountered retains optimality of the 
closed-loop system. This, in term, guarantees the robustness 
of performance. This fact has been verified in this chapter 
when it is seen that under various load conditions, there is 
no significant change in the performance. 
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It is worth noting here, that the controller as 
designed in Chapter three is a decentralized controller 
which makes the physical implementation of the controller 
very easy while resulting in a satisfactory performance. 
Although while finding out the controller all three joints 
were considered together, procedure is equally suited 
for designing the controller for individual joints if 
desired. 
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APPENDIX A 


L-E tquation of motion of a robot arm manipulator 
as given in (2.2,1) is rewritten here as equation (A.l) 


D(q} q + h(q, + c(q) = f 


This equation can also be written as (lOj 


n 


n n 


T If qif +E 21h.. q, q+c =f 
^ k=l m=l ^ ™ i i 


k=*l 


where 


n 




dWj 


dv»' 


'’llcm “ 


n 




T 

dw: 


n 


and c. 


dW4 


s (-mj g ^ 3, ^ 


j=i 


for i,k,m B 1,2,. ...,n 


and g « gravity vector [g^^, g^, g^, 0]^ 


(A.l) ^ 


(A.2) 


(A.3) 


“ n-f oWj 

^ Tr (x; — 2b“ J. -T-*^) (A. 4) 

jesjnax(i,k,m) \ ^ ^i 


(A, 5) 


j « Co-ordinate of the centre of mass of the 


,th 


j link expressed in its own co-ordinate 
frame. 

6 W. A/ 


Define ^ ;= -5^ and - ‘SqT^ 


'ij 




central library 

I I KANPUR 


1 

J ‘k 
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n 


S “ik ^ 


n n 


k*sl 


Tr (U,. J, ujjq 


k=l j=max(l,J)' ik ■'J 


Let ys expand this term for i = i and n = 3 


3 3 3 _ 

. ^Ik \ ^ 2 Tr(U.. J. uTjq. 

15.5,2 ** * j ^_2 Jk J jl'^k 


= IrCUi^JjuT^) q^H-Tr(U2iJ2u|i) 4 ^ 


+ TrCUgj^JgUjj^) qj^ + Tr(U22J„u|g) qj 


+ TrCUggJgUj^) + Tr(U33J3uJ^) ,3 


Rearranging the terms above 


^^2 Tr(U22J2^2l^ ^*1 


Tr{U22J2uj2) ^2 + 


*•* ^^(^31'^3'^32^ ^2 ^^^’^31'^3^33^ ^3 


E I Tr(U^^J^U^2) % 
J*1 k«l JK J Ji 


Also noting that trace of a matrix and its transpose are 

equal, above equation can be written as 

3 / T \ " 

I d,^ V = I s Tr(U.,J.U ) q,^ 

k.=l Ik 1=1 k=l Jl J Jk k 


Similarly foi i = 2» it can be shown that 


.r'.’ V'’"''’ '' *’ C‘" ' . 

.i,'- ' 








k»l 


and so on. Hence 


^ '^Ik «k “ Jj (A.6) 


k-1 


Similarly, 


n n 

E E h, 1 4. 4 

i/'-t mZi 
IC*X Bi*i 


n n n 
Z 

k^l m 


Z Z Tr(U..j- J.U^,) 

»! j=max(i,k,m) ^ 


For i * 1 and n « 3, above equation 

3 3 3 3 3 

E £ h.. q. q„ = Z Z Z .* 

k«l ffi*l ^ ® k=l m=l j=max(i,k,m) 




+ ^^^^311’^3^L^ *^1 ■‘' ^^^^2l2'^2^2l^ '^ 1^2 

T 

+ Tr(U3^2'^3U3TL) 4^42 + Tr(U3^3J3U3;^) qj^q3 
+ + Tr(U33j^J3U3j^)43q2 + ^^(^332'^3^31^'^3‘^2 

+ Tr(U333J3uJi) 4^ 



;=1 mfl ''1'“” ^1 Tr(U2^jJ2u|^)4^ 


J a^2 


+ Tr(U2^2'^2^2l)‘^1^2 -^7^(^221^2^21) Ml 

+ Tr(U222J2^2l) ^2 '*' ^31 73*^31 ^'^l 

+ Tr(U3j^2ML) ^1^2 ■*; ^^(^313'^3^L)^73 

+ T^(U3273U3i)‘?2^1 ^^(^322'^3^3i)^2 

+ Tr(U323J3U3j^)q243 + ^ 331 ^ 3 ^ 31 ) Ml 

+ Tr(U332J3U3i)q3q2 + ^^(^333'^3^3 i)^3^2 

j=l k=l Jb=l J ^ 

= Z Z Z (Tr(U,.J uj ) q q.) 

j=l k=l Jb-l ^ ^ ^ 


Similarly for i = 2 it can be shown that 

j . 


3 

3 


n 

j 

Z 

k=l 

Z 

m=l 

''2km W = 

Z 

j=2 

Z 

k=l 

and so 

on. 

Hence 



n 

n 


n 

3 

Z 

k=l 

Z 

m=l 

^ikm ^k'^m *" 

Z 

j=i 

Z 

k=l 




(TrCU-iJiUlk )q, , ) 


(A.7) 


And from (A. 5) we have 
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d, = (-"j g‘ uji 


(A. 8) 


n n n 

Substituting for ^ik ‘^ikm \% and 

k=l k=l ni=l 

from equations (A, 6) and (A. 7) and (A. 8) respectively into eq, 
(A.2) , we have 

E Z Tr(U..J.U^. ) q. + 2 Z Z (Tr(U..J.U^. )q. q.) 

-j=i k=l 01 1 JK k jl 3 3^1 


+ Z (-m. U . j ) = f 

T — *1 J 


n i dWj dwj .. 

Z [ Z (Tr(^ Jj -5^) q^) 
j=i k=l ^k 


j j ^ dWj 

+ L Z (Tr(x^ J, 


T . 


k=l 1=1 


dq. ^3 ^ ^k^" “j ^ dq^ 
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APPEMDIX B 

Link Parameter and Mass Properties of PUMA--560 Robot 


1.1 Link Parameters 


Joint 

Number 

®i 

(in degrees) 

“i 

(in degrees) 

®i 

(in meters ) 

d. 

1 

(in meters) 

1 

-160° to 60° 

1 

\D 

0 

0 

0 

0 

2 

-225° to +45° 

0 ° 

0.4318 

0.1495 

3 

-45° to 225° 

0 

0 

0 

0 


1,2 Mass Properties 


Inertia tensors of first three links of PUMA-560 are 
given below : 

diag = [0.0071, 0.0267, 0.0267] Kg 

diag J 2 = [O.IOOO, 0.7300, 0.8025] Kg 

diag J 3 = [0.0222, 0.2160, 0.2245] Kg 

1,3 Centres of Gravity of Links 

First link [0.0, 0.0, 0.073]^ m 
Second link [-0.4318, 0.0, O.O]^ m 
Third link [0.0, 0.0, 0.1]^ m 


Mass 

of 

Links 

®1 

sss 

2,27 Kg 

m2 

ss 

15,97 Kg 

«3 

sss 

11.36 Kg 


1.4 



APPENDIX C 


Trajectory Point 1 ; 

■ ' T* 

cj = [Oo2, 0»2j 0.2] rad Nominal torque 

q = [1, 1, 1]^ rad/s 
q = [l, 1, l]^ rad/s^ 

NO-LOAD CONDITION 

A-MATRIX 


O.OOOOOOOE+00 

-0.2618776E-09 

o«oooooooE+oo 

0.4047156E-08 

O.OOOOOOOE+00 

-0.6787522E~08 


1.000000 

0.5052836 

OoOOOOOOOE+00 

5.139830 

O.OOOOOOOE+00 

-36.09692 


O.OOOOOOOE+00 

-1.012501 

O.OOOOOOOE+00 

2.366487 

O.OOOOOOOE+00 

-33.83332 


O.OOOOOOOE+00 

-0.1191027 

O.OOOOOOOE+00 

-0.8486320 

O.OOOOOOOE+00 

4.050746 


B-MATRIX 


O.OOOOOOOE+00 

0.2438718 

O.OOOOOOOE+00 

-0.2343241E-01 

O.OOOOOOOE+OO 

0,1351310 


O.OOOOOOOE+OO 

-0.2343241E-01 

O.OOOOOOOE+OO 

0.3621334 

O.OOOOOOOE+OO 

-0.6073373 


3 Kg LOAD CONDITION 


O.OOOOOOOE+OO 

0.1351310 

O.OOOOOOOE+OO 

-0.6073372 

O.OOOOOOOE+OO 

4.047957 


O.OOOOOOOE+OO 

-0.1733694E-09 

O.OOOOOOOE+OO 

0.2695879E-08 

O.OOOOOOOE+OO 

-0.4493965E-O8 


1.000000 
0.5216651 
O.OOOOOOOE+OO 
5,102533 
O.OOOOOOOE+OO 
-35.57309 


A-MATRIX 

O.OOOOOOOE+OO 
-0.9939919 
O.OOOOOOOE+OO 
2.328399 
O.OOOOOOOE+00 
-33.29985 


= L5«289 -46.034 


O.OOOOOOOE+OO 

0.4358792 

1.000000 

-0.7057863 

O.OOOOOOOE+OO 

3.278110 

O.OOOOOOOE+OO 

-0.2342148 

O.OOOOOOOE+OO 

-0.6262366 

1.000000 

0.9416308 


O.OOOOOOOE+OO 

0.1343015 

1.000000 

-0.7026666 

O.OOOOOOOE+OO 

3.234465 
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O.OOOOOOOE+00 
-0.1207158 . 

OcOOOOOOOE+00 

-0.8447819 

O.OOOOOOOE+00 

3.996607 

B-MATRIX 


O.OOOOOOOE+00 
0.2435136 
0«0000000E+00 
~0.2326925E-01 
O.OOOOOOOE+00 
Oo 1330774 


O.OOOOOOOE+00 

-0.2326925E-01 

O.OOOOOOOE+00 

0.3618347 

OoOOOOOOOE+00 

-0.6031698 


O.OOOOOOOE+00 

0.1330774 

O.OOOOOOOE+00 

-0.6031698 

O.OOOOOOOE+00 

3.989610 


6 Kg LOAD CONDITION 


A-MATRIX 


0, 0000000 E+00 
0.7912618E-09 
O.OOOOOOOE+00 
-0.1743076E-08 
O.OOOOOOOE+00 
0.2446058E-07 


1.000000 

0.5527586 

O.OOOOOOOE+00 

5.031367 

O.OOOOOOOE+00 

-34.57340 


O.OOOOOOOE+00 

-0.9586863 

O.OOOOOOOE+00 

2.255713 

O.OOOOOOOE+00 

-32.28176 


O.OOOOOOOE+00 
-0. 1237700 
0.0000000 E+00 
-0.8374358 
O.OOOOOOOE+00 
3.893287 


B-MATRIX 


O.OOOOOOOE+00 

0.2428057 

O.OOOOOOOE+00 

-0.2295645E-01 

O.OOOOOOOE+00 

0,1291578 


O.OOOOOOOE+00 

-0,2295645E-01 

O.OOOOOOOE+00 

0.3612648 

OoOOOOOOOE+00 

-0.5952165 


O.OOOOOOOE+00 
0. 1291578 
O.OOOOOOOE+00 
-0.5952165 
O.OOOOOOOE+00 
3.878259 


O.OOOOOOOE+OO 

■0.2341027 

O.OOOOOOOE+OO 

■0.6258833 

1.000000 

0.9364464 


O.OOOOOOOE+OO 

0.1312866 

1.000000 

■0.6967125 

O.OOOOOOOE+OO 

3.151171 

O.OOOOOOOE+OO' 

•0.2338642 

O.OOOOOOOE+OO 

-0.6252104 

1.000000 

0.9265528 
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TRAJECTORY POINT NO, =2 
T 

q = [O, 0, O] rad Nominal torque = [O, -48,124, 0]^ 

q = [0, 0, O]^ rad/s 
q = [0, 0, O]^ rad/s^ 

A-MATRIX 


0. 0000000 E+OO 

O.OOOOOOOE+OO 

0. OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

lo 000000 

-1.414231 

O.OOOOOOOE+OO 

1.120994 

O.OOOOOOOE+OO 

-33.99983 

O.OOOOOOOE+OO 

-1.414231 

O.OOOOOOOE+OO 

1.120994 

O.OOOOOOOE+OO 

-33.99983 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

1.000000 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 



O.OOOOOOOE+OO 

o.oooooooe+o(7 



O.OOOOOOOE+OO 

O.OOOOOOOE+OO 



O.OOOOOOOE+OO 

O.OOOOOOOE+00 



Oc OOOOOOOE+OO 

O.OOOOOOOE+OO 



O.OOOOOOOE+OO 

1.000000 



Oc OOOOOOOE+OO 

O.OOOOOOOE+OO 


B-MATRIX 


" O.OOOOOOOE+OO 

Oo OOOOOOOE+OO 

Oc OOOOOOOE+OO ~ 


0,2594140 

-0.4331147E-02 

0.1313640 


O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

Oc OOOOOOOE+OO 


-0.4331147E-02 

0,3458301 

-0,4465231 


O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

Oc OOOOOOOE+OO 


0,1313640 

-0.4465231 

3.500546 _ 


3 Kg LOAD CONDITION 

A-MATRDC 


'O.OOOOOOOE+OO 

1,000000 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

-1,391847 

-1,391847 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

Oc OOOOOOOE+OO 

1.000000 

O.OOOOOOOE+OO 

1.104652 

1,104652 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

-33.50417 

-33.50417 

O.OOOOOOOE+OO 
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OoOOOOOOOE+00 

o,oooooooE+oo 

O.OOOOOOOE+00 
O.OOOOOOOE+00 
0. OOOOOOOE+00 
0.0000CXX)E+00 


0„0000000E+00 
0.2589986 
O.OOOOOOOE+00 
•O. 4262594E-02 
O.OOOOOOOE+00 
0. 1292848 


B-MATRIX 

O.OOOOOOOE+00 
-0«4262594E-.02 
0. OOOOOOOE+00 
Oo 3457801 
O.OOOOOOOE+00 
-0,4450051 


O.OOOOOOOE+00 

0.1292848 

O.OOOOOOOE+00 

-0.4450051 

O.OOOOOOOE+00 

3.454506 


6 Kg LOAD CONDITION 


A-MATRIX 

1 . 000000 0. OOOOOOOE+00 

-1.348994 -1.348994' 

0 . OOOOOOOE+00 0 . OOOOOOOE+00 
1.073357 1.073357 

O.OOOOOOOE+00 0. 0000000 E+00 
-32.55499 -32.55499 

O.OOOOOOOE+00 

O.OOOOOOOE+00 

O.OOOOOOOE+00 

O.OOOOOOOE+00 

O.OOOOOOOE+00 

O.OOOOOOOE+00 

B-MATRIX 


O.OOOOOOOE+00 

O.OOOOOOOE+00 

0,0000000E+00 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

0oCX)00000E+00 


~ O.OOOOOOOE+OO 
0.2581784 
O.OOOOOOOE+OO 
-0.4131356E-02 
O.OOOOOOOE+OO 
0.1253043 


O.OOOOOOOE+OO 

-0.4131355E-02 

O.OOOOOOOE+OO 

0.3456842 

O.OOOOOOOE+OO 

-0.4420982 


O.OOOOOOOE+OO 
0. 1253043 
O.OOOOOOOE+OO 
-0.4420982 
O.OOOOOOOE+OO 
3.366339 


O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

1.000000 

O.OOOOOOOE+OO 


O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

1.000000 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

O.OOOOOOOE+OO 

1.000000 

O.OOOOOOOE+OO 

# ' ■ , — 



.1 U o b b - 




ok Is to be returned on the 


H<i2e 








